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ABSTRACT 


With  the  increased  use  of  robots  in  industry  and  the 
military,  new  robot-specific  actuators  will  be  developed  to 
better  meet  functional  requirements.  One  concept  to  be 
considered  is  a  stiff  pneumatic-hydraulic  actuator  for 
mobile  anthropomorphic  robot  application. 

This  thesis  documents  analysis  of  the  feasibility  of 
such  an  actuator.  Computer  modeling  and  simulation  are 
accomplished.  A  hardware  test  bed  with  microcomputer 
control  and  parameter  sensing  interface  is  designed  and 
constructed  for  the  purpose  of  model  validation  and 
demonstrations.  Automatic  control  software  is  designed  and 
implemented  on  the  test  bed,  and  performance  evaluations  are 
made.  From  the  observations  made  during  the  analysis 
process,  design  recommendations  are  formulated  and  proposed. 
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I. 


INTRODUCTION 


Robotic  applications  have  increased  steadily  with 
advancing  technology.  Installation  of  manipulators  to 
automate  assembly  line  tasks  has  become  commonplace  because 
of  the  increased  productivity,  reliability,  and  cost  savings 
which  can  be  realized  through  their  use.  Projections 
estimate  the  value  of  the  industrial  robot  population 
worldwide  to  be  10  billion  dollars  by  the  year  1990 
[Ref.  1].  The  military  is  also  interested  in  the 
application  of  robotics  to  missions  where  they  may  decrease 
risks  to  personnel  and  significantly  enhance  the  probability 
of  mission  completion  [Ref.  2]. 

A  divergence  in  requirements  between  commercial  and 
military  robotic  devices  occurs  because  of  the  military  need 
for  mobility.  While  industrial  manipulators  are  most  often 
used  in  stationary  installations  such  as  factories,  the 
nature  of  military  missions  dictate  that  a  manipulator  must 
be  able  to  go  to  the  location  where  its  task  will  be 
accomplished,  instead  of  having  the  job  brought  into  its 
operating  envelope.  The  mobility  issue  brings  with  it 
additional  requirements  for  manipulator  subsystems  which  are 
usually  not  considered  in  a  stationary  design.  Some  of 
these  are  power  supply  weight,  system  endurance,  and 
ruggedness  in  changing  environments. 
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Manipulator  actuators  must  generally  satisfy  a  larger 
number  of  functional  criteria  than  similar  power  delivery 
devices  used  in  other  systems.  In  addition  to  efficiency 
and  reliability,  the  desirable  qualities  of  the  actuators 
for  a  robot  arm  may  include  high  torque  or  force  output 
throughout  translation,  quick  response  to  signal  orders, 
smooth  reversibility,  high  stiffness  with  low  power 
consumption  when  idle,  positioning  accuracy,  and  any  other 
characteristics  which  are  dictated  by  the  functions  which 
drive  the  total  system  design.  Traditional  choices  for 
actuators  have  been  confined  mainly  to  electric  motors  and 
either  hydraulic  or  pneumatic  motors  and  cylinders.  While 
each  actuator  category  has  been  used  successfully  in 
manipulator  applications,  satisfactory  conformity  to  the 
list  of  qualities  needed  is  often  difficult  to  achieve. 

An  innovative  actuator  type  which  may  conform  better  to 
manipulator  system  requirements,  particularly  in  mobile 
applications,  is  the  stiff  pneumatic-hydraulic  actuator 
[Ref.  3].  Figure  1  is  a  notional  diagram  of  the 
construction  of  such  an  actuator  in  cross  section,  suitable 
for  use  in  a  low  power,  light  load  application  [Ref.  4]. 

The  main  motive  power  for  this  actuator  would  be  provided  by 
a  low  pressure  compressed  air  source.  In  a  mobile  arm,  this 
could  conceivably  be  a  rechargeable  high  pressure  air  tank 
with  a  regulator.  The  closed  loop  hydraulic  side  is  a 
computer  controlled,  self-contained  circuit  which  adds 
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igure  1.  Conceptual  Novel  Actuator 


motion  dampening  for  precise  position  control  during 
translation — a  feature  that  pneumatic  cylinders  do  not 
normally  have.  When  ordered  position  is  reached,  the 
hydraulics  add  high  stiffness,  again  an  unusual  feature  for 
a  low  pressure  pneumatic  actuator. 

To  investigate  the  suitability  of  this  actuator  for  use 
on  a  mobile  operational  manipulator,  a  concept  feasibility 
was  conducted  using  the  systems  analysis  approach  and  the 
functional-based  design  principles  detailed  by  Blanchard  and 
Fabrycky  [Ref.  5].  Following  the  concept  analysis,  a  first 
order  mechanical  system  analysis  was  developed  which  was 
used  to  perform  system  simulations  to  gather  preliminary 
motion  prediction  data.  The  results  of  this  conceptual 
design  work  are  recorded  in  Reference  6. 

Components  of  an  operating  hardware  prototype  which  was 
used  for  concept  demonstration  were  received  from  the  Naval 
Ocean  Systems  Center.  Figures  2  and  3  show  the  components 
mounted  on  a  rigid  benchtop  base.  The  Novel  Actuator  Test 
Bed  was  created  from  this  apparatus  through  structural 
modifications  and  addition  of  computer  controllable 
hardware,  sensors,  and  interface  circuits. 

The  fundamental  purpose  of  this  thesis  was  to 
demonstrate  the  viability  of  the  novel  actuator  concept  by 
developing  and  demonstrating  a  controller  which  would 
deliver  satisfactory  performance.  Performance 
characteristics  were  developed  [Ref.  6]  and  used  as  the 
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Figure  2.  Demonstration  Model 


Figure  3.  Demonstration  Model 


5 


design  criteria  for  the  control  scheme  which  was  implemented 
on  the  Novel  Actuator  Test  Bed.  The  primary  characteristics 


were; 

1.  The  ability  to  move  and  position  a  maximum  five  pound 
payload. 

2.  The  ability  to  achieve  accuracy  in  placement  of  ±0.20 
inches  from  ordered  position. 

3.  The  ability  to  meet  a  point-to-point  placement  time 
within  the  operating  envelope  of  no  more  than  three 
seconds . 

The  general  design  procedures  used  in  the  thesis  were; 

1.  Develop  a  mathematical  model  description  of  the  system 
from  applicable  theory. 

2 .  Verify  that  the  model  provided  a  suitable  description 
of  system  dynamics. 

3.  Use  model  prediction  data  to  design  a  position  control 
system  meeting  the  above  guidelines  for  performance. 

4.  Implement  the  controller  and  check  compliance  with  the 
desired  characteristics. 
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II .  MODELING  AND  SIMULATION 


Description  of  the  Novel  Actuator  Test  Bed  system  for 
any  achievable  status  was  the  goal  of  design  modeling.  This 
was  completed  by  performing  two  separate  analyses.  An 
estimate  of  mechanism  stiffness  was  acquired  through 
analysis  of  rest  conditions.  Analysis  of  dynamic  conditions 
enabled  the  programming  of  a  numerical  simulation  which 
could  predict  system  motion. 

A.  STIFFNESS  ANALYSIS 

A  simplified  model  of  the  Novel  Actuator  Test  Bed  was 
constructed  as  shown  in  Figure  4.  The  first  objective  was 
to  gain  a  measure  of  the  system  stiffness  when  the  joint  was 
stationary.  In  conducting  the  stiffness  analysis,  it  was 
assumed  that  the  mechanism  was  in  the  position  shown  in 
Figure  4,  that  the  contribution  of  the  air  cylinder  to 
stiffness  was  a  secondary  effect,  and  that  the  hydraulic 
cylinder  was  in  mid  stroke,  as  shown  in  Figure  5.  With  the 
air  cylinder  deenergized  and  the  hydraulic  solenoid  valve 
closed,  the  system  was  motionless.  The  stiffness  of  the 
mechanism  was  characterized  in  terms  of  pounds  per  inch  of 
deflection  away  from  the  no-load  position  when  a  load  was 
applied  to  the  linkage.  Consequently,  assuming  that  the 
foundation  and  linkage  materials  were  sufficiently  rigid  so 
that  structural  deflection  was  negligible,  the  system 
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Figure  4,  Sinplified  System  r-odel 


Figure  5.  Hydraulic  Cylinder  Model 
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stiffness  was  a  function  of  the  force  of  the  load 
transmitted  to  the  hydraulic  cylinder,  and  the  bulk  modulus 
of  the  hydraulic  fluid.  A  summation  of  moments  about  the 
pivot  point  (Figure  4)  gave: 

APhAjj^-II  =  ^^12 

In  turn,  the  pressure  difference  across  the  hydraulic 
cylinder  was  expressed  as: 


W2. 


AP„  = 


13 


H  A„2 


11 


(2) 


Since  the  rotary  deflection  of  the  mechanism  could  be 
expressed  in  terms  of  the  linear  deflection  of  the  hydraulic 
piston,  Xj,  further  stiffness  analysis  focused  on  the 
hydraulic  cylinder  as  modeled  in  Figure  5.  The  assumption 
was  made  that  flow  past  the  rod  seals  and  piston  seals  was 
negligible.  These  leakage  flows  would  be  the  only  flows 
possible  for  this  model,  so: 


Q  =  0 


(3) 


The  mass  of  fluid  in  each  chamber  of  the  cylinder  was: 


m  =  p  V 


(4) 
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Applying  the  continuity  equation  to  the  chambers: 


dm  _  d  ( pV) 
dt  ^  dt 


or 


dm 

dt 


P 


dt 


+  V 


dp 

dt 


The  bulk  modulus  was  defined  as: 


(5) 


(6) 


Assuming  that  the  pressure  of  the  fluid  was  independent  of 
temperature  gave: 


B 


dP 
^o  dp 


Substituting  this  into  Equation  (5)  : 


dm 

dt 


dP  1, 
d  6^ 


(7) 


or 
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dm  _  ^  ,  pV  ^  (8) 

dt  ^  dt  B  dt 


Dividing  this  resultant  by  p  gave  an  equation  for  Q: 


^  _  dV  V  dP 
Q  -  at  B  dt 


(9) 


The  assumption  that  Q  =  0  yielded: 


dV 

dt 


V  dP 
6  dt 


For  each  chamber  of  the  hydraulic  cylinder: 


dV 


4 

dt 


V4  dP^  dV^ 


B  dt 


dt 


B  dt 


or 


dV, 

V, 


1  *^^5 


-  f  ^^5 


Integrating  both  sides  of  each  equation: 


V, 


ln(: 


04 


—  (P  -P 

B  4  ^04 


)  ,  In(^)  = 


V 


05 


(10) 


(11) 


(12) 
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Then,  assuming: 


PoA  ~  Po5  ~  pQ  !  ^04  ^05  —  Vq 

(thus  =  £^=  X,  as  in  Figure  5)  .  Solving  each  equation 
for  Pq  then  combining  yielded  an  expression  for  the  pressure 
difference  across  the  piston: 


Pq  -  P4  +  ln(^)S  ,  ^0  =  ^5  + 


''4  ''5 

P.  +  ln(^)6  =  Pc  +  ln(^)6 
^00 


V5 


(13) 


V  =  A(J.  +  X,  )  ,  V.  =  A(£  -  X,  ) 


(14) 


h(l  +  X^) 

''4  -  ®  -  x;y‘ 


1  +  X  /«. 

^  "^^1  -  xV 


(15) 
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Solving  for  linear  deflection  X,  and  substituting  for  APj, 
using  Equation  (2)  gave: 


exp(AP  /6)  -  1 

^1  "  ^exp(APj^/6)  +  1^  ^ 

exp  ~  ^ 

^1  ^  ^expiWi^^/A^SL^^B)  +  1^  ^ 

Stiffness  was  assigned  a  value,  k,  which  followed  the 
equation: 


w  =  k 


or 


(17) 


Substituting  the  value  for  Xj  from  Equation  (16)  yielded: 


k 


_ W _ 

exp  -  1 

exp  +  1 


£ 


(18) 


An  effective  bulk  modulus  for  the  system  can  be  found 
using  the  method  described  by  Merritt  [Ref.  7].  A  small 
volume  of  trapped  air  within  the  hydraulic  system  can  be 
seen  to  greatly  reduce  the  bulk  modulus  and  thus  the 
stiffness  of  the  mechanism.  A  representative  calculation  of 


14 


volume  of  trapped  air  within  the  hydraulic  system  can  be 
seen  to  greatly  reduce  the  bulk  modulus  and  thus  the 
stiffness  of  the  mechanism.  A  representative  calculation  of 
stiffness  for  the  mechanism  was  made.  It  was  assumed  that 
there  was  no  entrained  air  in  the  system.  A  value  for  the 
bulk  modulus  of  220,000  psi  [Ref.  7]  for  petroleum  based 
hydraulic  fluids  was  used  in  Equation  (18) ,  along  with 
appropriate  measured  dimensions  and  a  load  value  of  five 
pounds.  The  stiffness  of  the  mechanism  was  calculated  to  be 
10,242  pounds  per  inch. 

B.  DYNAMIC  MOTION  ANALYSIS 

Some  refinement  was  necessary  to  improve  the  system 
dynamic  model  developed  [Ref.  6]  using  first  order 
approximations.  Equations  of  motion  for  both  raising  and 
lowering  motions  of  the  mechanism  were  desired  which  would 
more  closely  represent  actual  system  behavior,  and  deliver 
acceptable  accuracy  of  the  system  model.  The  most 
significant  model  improvement  was  to  account  for  changes  in 
the  linkage  geometry  throughout  the  entire  range  of  motion. 
The  forces  on  the  linkage  were  then  resolved  into 
components,  and  those  components  not  contributing  to  system 
dynamics  were  discarded. 

Forces  acting  on  the  linkage  for  both  motions  are  shown 
in  Figure  6.  A  similar  analysis  was  used  for  each  case  to 
obtain  the  equation  of  motion  [Ref.  8].  The  following 
presentation  is  for  the  case  of  a  raising  motion. 
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A  summation  of  moments  about  point  o  in  Figure  6A 


resulted  in  the  following  equation: 


-je  -  -  W^(Jl32  +  - 


^H^ll  ^P^12  ° 


or 


F  o 
P  12 


-  '■h'u  -  ”‘l3 


-  ^<*12  + 


-  je 


(19) 


As  a  point  of  reference,  the  zero  position  for  the 
rotational  coordinate  e  was  defined  to  be  when  the  linkage 
bar  was  parallel  to  the  base  structure,  as  depicted  in 
Figure  4.  Further,  a  clockwise  motion  from  this  position 
would  describe  a  positive  value  of  e.  Consequently,  when 
the  linkage  was  away  from  the  zero  position,  only  a  portion 
of  the  forces  contributing  to  the  moments  in  Equation  (19) 
were  effective  in  causing  system  motion.  Relative 
coordinates  x  and  y,  with  x  being  parallel  to  the  long  axis 
of  the  linkage  bar  and  y  being  perpendicular  to  the  long 
axis,  were  chosen  to  help  separate  the  forces  into 
components.  As  illustrated  in  Figure  7,  only  the  y 
components  of  the  load  and  cylinder  forces  were  important  to 
system  dynamics.  The  revised  system  equation  was: 
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The  active  components  of  the  load  terms  depended  only  upon 
coordinate  6.  So: 


W  =  W  COS  6  , 

y 


w  COS  e 

Ij 


(21) 


To  solve  for  the  y  components  of  the  cylinder  forces,  it  was 
necessary  to  utilize  a  variable  angle  a,  shown  in  Figure  7, 
which  was  a  function  of  the  rotational  coordinate  e.  Figure 
8  illustrates  the  additional  mechanism  geometry  necessary  to 
solve  for  q.  The  active  cylinder  components  were: 


Fpy  =  Fp  Sin  Up 


(22) 
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The  foundation  angles  Bp  and  Bf,  were  calculated  from  fixed 
lengths : 


-1  ^12 
=  cos  (j^) 

^  ^FP 


(24) 


r  -1  , 

H 


(25) 


The  variable  angles  <^p  and  <)!{,  were  defined  as; 


<^p  =  3p  +  6 


(26) 
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Typical  Linkage  Geometry  (Angular  Relations 
Exaggerated) 


=  Bjj  -  e  (27) 

Trigonometric  relations  were  then  used  to  solve  for  the 
supplementary  angles,  »jp  and  f?a,  to  the  respective  a  angles, 
and  enabled  solutions  for  Qp  and  0^: 


«-p  + 

X2  = 

(28) 

^1  = 

«U 

(29) 

.  -1 

’^P  = 

sin 

(30) 

sin  ^ 

£ 

r  /  FH  , 

[  (_ - _)  sin 

H  *■  ^1 

«h1 

(31) 

ap  =  ^  -  rip  (32) 

oIh  =  ■"  -  Hh 

The  remaining  task  in  the  dynamic  analysis  was  to  cast 
all  the  terms  of  Equation  (20)  in  a  common  variable 
coordinate.  The  rotational  coordinate  e  was  chosen,  and  the 
cylinder  forces  were  examined  to  perform  any  necessary 
coordinate  transformations. 

Figure  9  shows  the  forces  acting  on  the  air  piston.  The 
piston  areas  were: 
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Figure  9.  Forces  Acting  on  the  Air  Piston 
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(34) 


A 


P 


(35) 


where: 


A-o  =  rod  area  = 

4 


So  summing  the  forces  yielded: 


A  P.  -  A^  P,  -  F  -  m  X-  =  0 
p  2  p  3  p  PP  2 


(36) 


Assuming  the  mass  of  the  piston  was  negligible: 


F  -  A  P  -  A  'p 
Fp  -  ^-^^2  P  3 

Volume  flow  equations  for  the  air  cylinder  and  control  valve 
[Ref.  9]  were  used  to  size  the  control  valve  to  exceed  the 
flow  required  to  meet  the  design  speed  criteria,  as 
discussed  in  Reference  6.  This  allowed  the  assumption  that: 


Fp  =  ApP^  (38) 

Thus,  for  a  given  supply  pressure,  the  force  delivered  by 
the  air  piston  was  specified. 
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Figure  10  shows  the  forces  acting  on  the  hydraulic 


piston.  The  area  of  the  hydraulic  piston  was; 


TT  ,2 

\  "  \h 


Summing  the  forces  as  with  the  air  piston  gave: 


Assuming  negligible  piston  mass  yielded: 


(39) 


(40) 


'■h  =  -  '‘5> 

Contrary  to  the  air  cylinder  case,  the  pressures  in  the  oil 
cylinder  were  not  known.  A  continuity  analysis  for  the  oil 
cylinder  provided  a  way  to  determine  the  pressure  drop 
across  the  piston  for  a  given  operating  speed  and  orifice 
area.  The  orifice  in  the  hydraulic  line  connecting  the 
cylinder  ports  was  treated  as  a  circular  orifice  through 
which  flow  was  turbulent.  The  following  equation  for 
volumetric  flow  through  the  orifice  taken  from  Merritt  [Ref. 
7]  was  applicable: 

Qh  =  ‘=<3  V 


where : 
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Qh  =  volumetric  flow,  inVsec, 

Cj  =  orifice  discharge  coefficient, 

Aoh  =  orifice  area  in  square  inches, 
p  =  density,  Ib-inVsec*, 

P4  =  chamber  4  pressure,  psig, 

P5  =  chamber  5  pressure,  psig. 

By  continuity,  flow  into  chamber  5  equaled  flow  out  of 
chamber  4,  so: 


Q4 


Also: 


(43) 


Q4  -  =  Ajj  (44) 

Combining  Equations  (42)  and  (43)  and  solving  for  the 
hydraulic  pressure  difference  gave: 


P 


4 


Vi 

^d^oh 


2 

) 


(45) 


Transformation  of  this  expression  into  terms  of  e  was 
achieved  by  solving  the  combination  of  Equations  (27)  and 
(29)  for  Xi,  taking  the  derivative  of  the  result,  and 
substituting  into  Equation  (45) : 
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(47) 


•  •  2  2  -1/2 


P  — P  =  —  {' 
M  5  2^ 


sin(3jj-e) 


- 5 - 5 — 1/2 


(48) 


The  hydraulic  cylinder  force  was  then  put  into  a  form 
dependent  upon  rotational  coordinate  B: 


^  ‘^d^oh^^FH^'^^'ii  “^^FH^ii  °°s(aj^-e)j 


(49) 


Equation  (20)  represented  the  system  equation  of  motion. 
The  supporting  equations  necessary  to  define  the  terms  of 
this  expression  in  a  common  coordinate  were  Equations  (21) 
through  (33)  and  Equations  (38)  and  (49).  A  numerical 
simulation  program  incorporating  these  equations  was  written 
for  use  with  the  Dynamic  Simulation  Language  (DSL)  software 
environment  available  on  the  IBM  3033  mainframe  computer 
network  [Ref.  10].  DSL  used  a  Runge-Kutta  equation  solving 
routine  to  solve  the  expression  for  0  and  its  derivatives. 
The  model  simulation  was  then  exercised  to  obtain  motion 
predictions  of  mechanism  position  and  velocity  versus  time 
in  response  to  given  inputs  of  air  supply  pressure  (PJ  , 
applied  load  (W) ,  and  hydraulic  modulating  orifice  opening 
(Aoh)  •  A  listing  of  the  DSL  programs  used  to  predict 


27 


response  for  both  raising  and  lowering  motions  can  be  found 
in  Appendix  A. 
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III.  MODEL  VALIDATION 


A  hardware  platform  was  necessary  in  order  to  verify 
that  the  theoretical  model  provided  an  acceptable  forecast 
of  an  actual  system's  motion.  Therefore,  the  original 
concept  demonstration  model  was  modified  to  enable  computer 
control  and  data  acquisition.  Experimental  data  runs  were 
then  made  for  a  full  range  of  load  conditions  and  hydraulic 
control  orifice  openings.  Finally,  comparison  of  actual  and 
theoretical  data  was  made  to  determine  model  validity. 


A.  TEST  BED  CONSTRUCTION 

Construction  of  the  Novel  Actuator  Test  Bed  allowed 
computerized  operation  and  monitoring  of  the  concept 
demonstration  hardware  model  for  the  purposes  of  actual  data 
collection  to  validate  the  theoretical  model  predictions. 

It  also  provided  the  apparatus  needed  in  order  to  implement 
a  position  controller  and  determine  its  performance.  The 
following  list  contains  descriptions  of  the  major  components 
of  the  Novel  Actuator  Test  Bed: 

1.  Air  Cylinder:  Clippard  Minimatic  UDR-173.  1  1/16 

inch  bore,  3  inch  stroke,  5/16  inch  rod  diameter. 

2.  Hydraulic  Cylinder:  Clippard  Minimatic  H9D-3D.  9/16 

inch  bore,  3  inch  stroke,  1/4  inch  rod  diameter. 

Air  Cylinder  Control  Valve:  Koganei,  Ltd.  110  series, 
5  port  3  position  closed  center,  solenoid  operated, 

24V  DC.  Rated  flow  of  14  scfm  at  100  psig  supply 
pressure  with  a  response  time  of  30  milliseconds. 


3. 


4.  Hydraulic  Orifice  Control  Valves:  Skinner  Precision 
Industries  B  series,  miniature  3  port,  solenoid 
operated,  24V  DC.  Rated  150  psi  with  3/64  inch 
passage  diameter  and  a  response  time  of  4  to  8 
milliseconds . 

5.  Position  Sensing  Device:  Sumtak  model  LBL  incremental 
optical  shaft  encoder,  2048  pulses  per  revolution. 

6.  Computer:  IBM  PC  XT  with  8087  math  coprocessor. 

7.  Computer-Sensor  Interface:  Fischer  Computer  Systems 
SEC-PC  shaft  encoder  counter  interface  board,  4  state 
change  counts  per  input  pulse,  binary  counter  chips, 
fully  addressable  TTL  input  and  output  ports  capable 
of  being  used  for  component  control. 

8.  Computer-Valve  Interface:  In-house  manufactured 
solenoid  valve  interface  board  and  24V  DC  power 
supply,  one  Crydom  6311  opto-isolated  SSR  output 
module  per  solenoid,  capable  of  actuating  valve 
solenoid  in  response  to  a  TTL  logic  signal  through  the 
output  port  of  the  SEC-PC  board.  A  detailed  schematic 
of  the  solenoid  valve  interface  is  included  as 
Appendix  B. 

The  components  of  the  test  bed  were  mounted  on  and 
within  the  foundation  base  structure  as  shown  in  Figures  11 
and  12.  Data  transmissions  to  and  from  the  computer  were 
made  through  a  50  pin  "D"  connector  to  the  SEC-PC  board 
installed  in  an  expansion  slot.  Control  of  fluid  flow 
between  the  two  chambers  of  the  hydraulic  cylinder  was 
accomplished  by  a  parallel  arrangement  of  four  different 
fixed  size,  solenoid  valve  operated  orifices.  The  size  for 
the  smallest  orifice  was  chosen  based  upon  speed  predictions 
of  the  first  order  approximation  system  analysis  done  in 
Reference  6.  Each  subsequent  orifice  was  sized  using  the 
criteria  of  a  two-to-one  increase  in  area,  so  that  the 
fourth  orifice  had  an  area  eight  times  that  of  the  smallest 
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orifice.  Thus,  by  ordering  different  combinations  of  valves 
open,  it  was  possible  to  control  the  flow  from  one  side  of 
the  hydraulic  cylinder  to  the  other  with  a  choice  of  from 
one  to  15  times  the  area  of  the  smallest  orifice. 

Because  the  hydraulic  cylinder  demonstrated  a 
susceptibility  to  inducing  air  into  the  closed  hydraulic 
system  through  its  rod  gland  seals,  a  hydraulic  system 
pressurizer  was  installed.  This  consisted  of  a  fluid 
reservoir  piped  into  the  hydraulic  system  with  valves  to 
isolate  it  from  the  system  (Figures  11  and  12) .  Prior  to 
system  operation,  the  reservoir  was  pressurized  and  then  the 
isolation  valves  were  opened.  With  the  orifice  solenoid 
valves  also  open,  the  pressure  in  both  chambers  of  the 
cylinder  equalized  and  forced  the  cup-type  rod  gland  seals 
out  against  the  rod  and  the  seal  housing,  preventing  air 
from  being  drawn  in  by  piston  movement.  The  pressurizer 
isolation  valves  were  then  closed  and  the  system  was  ready 
for  operation.  The  hydraulic  system  integrity  was 
maintained,  and  the  initial  system  pressure  of  between  30 
and  40  psi  was  sustained  throughout  repeated  operations 
without  periodic  repressurization. 

B.  EXPERIMENTAL  SETUP 

The  arrangement  used  for  taking  data  for  model 
validation  is  shown  in  Figure  13.  Two  Kaman  pressure 
transducers  were  installed  at  pressure  taps  on  the  hydraulic 
cylinder  in  order  to  measure  the  hydraulic  pressure 
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difference  across  the  orifices  (P^  -  P5) .  The  pressure 
difference  signal  output  was  recorded  on  a  two  channel  strip 
chart  recorder.  An  Omega  series  PX302  pressure  transducer 
was  placed  on  the  supply  air  accumulator  to  monitor  Pi- 
Calibration  of  the  Kaman  transducers  was  accomplished  using 
a  differential  oil  piston  pressure  gage  calibrator,  and  the 
results  are  presented  in  Appendix  C.  Calibration  of  the 
Omega  transducer  (number  P4)  was  accomplished  in  concurrent 
work  by  Verbos  [Ref.  11].  Position  and  time  data 
acquisition  was  done  by  the  computer,  using  programs  written 
to  accomplish  the  tasks.  All  programs  to  test  the  operation 
of  the  Novel  Actuator  Test  Bed,  acquire  data,  and  eventually 
implement  automatic  position  control,  were  written  in 
compiled  BASIC  for  use  with  the  Borland  Turbo  BASIC  compiler 
[Refs.  12; 13].  Programs  related  to  data  acquisition  are 
shown  in  Appendix  D.  The  TESTOP  program  was  used  to  run  the 
Novel  Actuator  Test  Bed  mechanism  through  its  full  range  of 
motion  for  both  lowering  and  raising  moves,  while  recording 
encoder  position  in  counts  for  a  particular  time  in  a  data 
storage  matrix.  Time  was  measured  by  the  PC  system  clock, 
accessible  through  a  Turbo  BASIC  software  command,  with 
resolution  in  microseconds.  Termination  of  a  data  run  was 
effected  by  the  operator  at  the  finish  of  linkage  travel 
through  closing  of  a  "kill  switch”  which  was  hard  wired  to 
an  unused  bit  on  the  SEC-PC  board  input  port.  When  the 
TESTOP  program  detected  kill  switch  activation,  the  contents 
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of  the  data  storage  matrix  were  written  to  a  file,  which  was 
later  manipulated  using  the  MANIP  program.  This  transformed 
the  data  from  encoder  counts  to  the  different  coordinates  of 
interest  and  rendered  output  suitable  for  use  with  a 
computer  graphing  program.  The  program  sample  rate 
capability  with  the  described  computer  configuration  was 
approximately  one  encoder  read  every  4.66  milliseconds,  or 
about  200  reads  per  second. 

A  set  of  five  flat  plate  circular  one  pound  weights 
suspended  through  their  centers  by  lubricated  bushings  were 
used  to  provide  different  load  conditions  up  to  the  design 
payload  limit.  Data  collection  runs  were  made  for  each 
orifice  for  full  range  of  motion  raising  and  lowering  moves, 
and  load  conditions  from  zero  to  five  pounds,  in  one  pound 
increments. 

C .  RESULTS 

Data  presentations  were  made  for  the  two  extremes  of 
loading  conditions,  no  load  and  five  pounds,  and  the 
intermediate  load  condition  of  two  pounds.  Hydraulic 
pressure  difference  strip  chart  recordings  for  each  load 
condition,  orifices  one  through  four,  raising  and  lowering 
motion,  can  be  seen  in  Appendix  E.  Actual  position  versus 
time  data  for  the  same  conditions,  referenced  to  the 
hydraulic  piston  position  coordinate  Xj,  are  shown  in  graph 
format  in  Appendix  F. 
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To  obtain  the  best  possible  correlations  between  the 
theoretical  predictions  and  actual  data,  all  measurable 
quantities  were  recorded  as  accurately  as  possible  and 
entered  into  the  DSL  simulation  program  for  the  pertinent 
motion  case.  Linkage  bar  dimensions  were  measured  with  a 
dial  caliper  accurate  to  0.001  inch,  and  foundation  lengths 
were  measured  with  a  machinist's  scale  to  within  0.1  inch. 
Calculations  for  the  mechanism's  cumulative  mass  moment  of 
inertia  were  made  assuming  that  the  load  and  piston  masses 
were  concentrated  masses  acting  at  their  points  of 
attachment  on  the  linkage  bar.  The  linkage  bar  was  weighed 
and  assumed  to  be  a  rectangular  parallelepiped  for  moment  of 
inertia  calculation  purposes.  The  hydraulic  fluid  density 
was  measured  using  a  hydrometer,  and  was  corrected  to 
ambient  temperature.  The  orifice  sizes  were  machined  as 
accurately  as  possible  on  a  lathe,  the  closest  verification 
possible  of  orifice  size  was  a  measurement  of  the  tool  bit 
shank  size  with  a  micrometer,  due  to  the  extremely  small 
sizes  required. 

A  calculation  for  the  orifice  discharge  coefficient  was 
made  for  each  load  condition,  effectively  calibrating  the 
orifices  for  each  data  run.  Hydraulic  piston  speeds  were 
calculated  using  change  in  position  and  change  in  time 
values  picked  from  the  straight  line  portions  of  the  graphs 
in  Appendix  F.  Then  a  value  for  volumetric  flow  was 
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calculated  using  Equation  (43)  .  Equation  (42)  was  solved 


for 

Cd  giving: 

^  ^  _ _ 

(50) 

a 

^oh 

VI '"4  -  "5 

) 

A  summary  of  the 

calculated 

Cd  values  is 

shown  in 

Table  1 . 

TABLE  1 

SUMMARY 

OF  Cd  VALUES 

Orifice 

No.  Area 

Motion 

0  lb. 

Load 

2  lb. 

5  lb. 

1 

.0001917 

lower 

.4894  . 

.5081 

.5775 

1 

.0001917 

raise 

.4928 

.4348 

.2513 

2 

.0003801 

lower 

.6365 

.6726 

.7891 

2 

.0003801 

raise 

.  6540 

.4203 

.3803 

3 

.0007670 

lower 

.5678 

.6333 

.6469 

3 

. 0007670 

raise 

.5761 

.5714 

.3531 

4 

.0014522 

lower 

.4355 

.4251 

.4699 

4 

.0014522 

raise 

.4084 

.4000 

.2654 

The  following 

graphical 

comparisons 

of  actual 

versus 

predicted  data  are  for  the  conditions  representing  the 
corners  of  the  Novel  Actuator  Test  Bed  operating  envelope. 
Figures  14,  15,  16,  and  17  show  no  load  and  five  pound  load 
raising  and  lowering  motion  comparisons  for  the  smallest  and 
largest  orifices.  The  closest  agreement  between  model  and 
hardware  occurs  in  the  case  of  lowering  motions. 
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TIME.  SECONDS 


Figure  14.  Orifice  1,  No  Load,  Raising  and 
Lower inc  ^5otions 


THETA.  DEGREES 


Figure  17.  Orifice  4,  5  Lb  Load,  Raising 
and  Lowering  Motions 


Additionally,  the  no  load  predictions  were  generally  better 
than  the  loaded  cases.  It  was  anticipated  that  accounting 
for  second  order  approximation  effects,  such  as  friction  at 
the  rotating  joints  and  at  the  cylinder  walls  and  glands, 
would  have  produced  better  model  data.  The  predicted 
results  for  the  most  part  fell  within  an  experimental  error 
factor  of  ten  percent,  so  it  was  decided  that  the 
theoretical  model  offered  an  acceptably  accurate  description 
of  system  dynamics  throughout  the  operating  range  since  the 
purpose  of  the  model  was  to  develop  a  controller. 
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IV.  CONTROL  DESIGN 


The  design  and  implementation  of  an  automatic  control 
system  was  accomplished  through  use  of  the  simulation 
program  and  the  Test  Bed  hardware.  The  simulation  model  was 
used  to  assist  in  the  choice  of  controller  characteristics. 

A  computer  program  using  a  discrete  approximation  to  the 
controller  was  written  to  adapt  the  control  scheme  to  the 
existing  hardware.  The  actual  system  performance  was  then 
recorded  and  compared  with  the  model  predictions. 

A.  DESIGN  METHODS 

The  objective  of  the  control  system  design  was  to 
develop  a  controller  capable  of  meeting  the  stated 
performance  guidelines.  The  system  needed  to  automatically 
position  the  Novel  Actuator  Tesu  Bed  mechanism,  or  "plant,” 
as  described  by  Equation  (20)  and  the  other  supporting 
equations,  in  response  to  an  ordered  destination  different 
from  its  current  position.  Figure  18  illustrates  the  type 
of  control  system  required.  The  plant  was  inherently 
nonlinear,  chiefly  because  of  the  hydraulic  cylinder  force 
term  which  had  dependence  on  the  nonlinear  turbulent  orifice 
flow  equation.  Since  the  actual  control  method  of  four 
distinct  fixed  area  orifices  in  various  combinations  was 
being  used  to  roughly  approximate  servo  control,  it  was  not 
practical  to  try  the  linearization  schemes  possible  when 
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using  a  variable  opening  device  such  as  a  servo  valve 
[Ref.  7].  Consequently,  classical  frequency  domain  control 
design  methods  were  not  applicable  in  this  case.  However, 
from  exercising  of  the  DSL  simulation,  it  was  realized  that 
the  system  was  very  stable.  With  the  availability  of  an 
extremely  high  sample  and  order  delivery  rate  by  the 
computer  and  interface  board,  it  was  decided  to  use  a 
proportional  type  controller,  and  select  the  gain  for  the 
controller  by  a  cut  and  try  process  of  matching  the  gains  to 
the  desired  response  characteristics. 

The  controller  was  developed  using  "worst  case"  design 
principles;  that  is,  the  design  requirements  were  to  be  met 
or  exceeded  while  the  mechanism  was  operating  at  its  maximum 
limits.  In  this  instance,  "worst  case"  meant  meeting  the 
response  time  criteria  while  safely  raising  the  maximum  five 
pound  load.  The  DSL  simulation  program  that  was  used  to 
predict  system  response  was  also  used  to  investigate  likely 
candidates  for  the  proportional  gain  G.  The  control  loop 
was  closed  in  the  program  by  calculating  an  error  signal 
during  each  integration  step  equal  to: 

®  ~  ®DESIRED  ”  ®  actual  (51) 

The  hydraulic  control  orifice  area  was  then  programmed  as: 

Aol  =  G  e  (52) 
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The  program  was  run  several  times  for  different  parameter 
values  of  G,  so  that  the  resultant  response  curves  bracketed 
desired  performance.  Figure  19  shows  the  response  curves 
produced  for  a  range  of  five  values  of  G.  Based  on  this 
output,  a  value  of  G  equal  to  0.002  was  seen  to  deliver 
acceptable  response  as  delineated  by  the  design  criteria. 

B.  CONTROL  SCHEME  IMPLEMENTATION 

Figure  20  shows  the  ideal  controller  gain  curve  and  the 
discrete  approximation  to  the  curve  that  was  implemented  on 
the  Novel  Actuator  Test  Bed.  A  four  point  approximation  to 
the  curve  was  chosen  because  repeated  state  changes  of  the 
valves  during  motion  was  considered  less  desireable  from  a 
reliability  standpoint.  Also,  effective  areas  greater  than 
the  largest  orifice  size  (eight  times  that  of  the  smallest 
orifice)  corresponded  to  a  larger  error  value  than  the  full 
range  of  motion  of  the  mechanism.  This  was  a  promising 
indication  that  several  levels  of  performance  improvement 
over  the  chosen  design  criteria  were  possible  without  any 
hardware  alteration.  An  automatic  control  program  called 
CONTROL  was  written  and  is  listed  in  Appendix  G.  The  error 
values  were  translated  from  degrees  to  encoder  counts,  and 
orifice  control  valve  switching  was  effected  by  logic 
statement  tests  within  the  program.  The  smallest  acceptable 
error  was  chosen  to  be  when  the  mechanism  was  approximately 
.3  degrees  away  from  ordered  position.  A  block  diagram  of 
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Figure  19.  Response  Predictions  for 
Various  Gains,  G 
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Figure  20.  Continuous  Controller  Gain  Curve  and 
Discrete  Step  Approximation 


the  specific  control  system  showing  the  hardware  and 
software  relationships  is  illustrated  in  Figure  21. 

Figure  22  shows  the  predicted  and  actual  system  response 
curves  for  the  raising  of  a  five  pound  load  throughout  the 
entire  range  of  motion.  The  actual  response  using  a 
discretized  approximation  to  the  chosen  gain  proved  to  be 
very  close  to  the  predicted  response  using  a  continuous  gain 
curve,  and  all  the  design  guidelines  were  successfully  met. 
Positioning  accuracy  was  less  thc*n  +/-  .1  inch,  which  was 
half  as  small  as  the  allowable  limit.  The  switching  of  the 
orifice  valves  can  be  discerned  on  the  actual  response  curve 
as  points  of  changing  slope.  The  controller  was  rigorously 
tested  for  all  motions  and  load  conditions  within  the 
operating  envelope,  and  proved  to  be  both  accurate  and 
robust. 
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TIME,  SECONDS 


Figure  22.  Test  Bed  Response  to  a  Full 
Range  of  Motion  Order  with 
Maximum  Load 


V.  CONCLUSIONS  AND  RECOMMENDATIONS 

All  major  objectives  sought  in  the  investigation  of  the 
fitness  of  the  Novel  Actuator  for  robotic  application  on  a 
mobile  platform  were  successfully  achieved.  A  suitable 
system  model  was  found  which  acceptably  described  dynamic 
behavior,  and  was  highly  effective  in  use  as  a  design  tool 
for  creating  an  automatic  control  system.  Although  the 
theoretical  plant  model  was  nonlinear  in  nature,  the 
stability  of  the  system  enabled  the  cut  and  try  method  to  be 
effective  in  controller  design. 

The  Novel  Actuator  Test  Bed  offered  outstanding  return 
on  minimal  investment.  It  was  an  excellent  forum  for  proof 
of  theory,  and  implementation  of  the  control  design  in 
hardware.  The  use  of  the  digital  optical  encoder  to  sense 
position  eliminated  the  need  for  analog-to-digital  data 
conversion,  and  the  SEC-PC  interface  board's  multiple 
capabilities  contributed  to  system  simplicity.  The  IBM  PC 
was  well  suited  as  a  controlling  apparatus,  and  along  with 
the  compiled  BASIC  software  operating  environment  it  helped 
provide  a  well  behaved  and  rugged  system. 

The  automatic  controller  easily  conformed  to  the 
specified  design  guidelines,  and  sufficient  overhead  exists 
in  installed  hardware  to  make  significant  improvements  in 
performance . 
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Observations  made  during  mechanism  operations  have 
suggested  the  following  design  recommendations  for 
application  to  proposed  Novel  Actuator  detail  design  and 
development  [Ref.  5].  Recommendations  are  segregated  into 
general  areas  of  applicability,  and  an  intuitive 
determination  of  whether  implementation  would  be  a  high  cost 
(HC) ,  low  cost  (LC) ,  or  no  cost  (NC)  improvement  has  been 
made. 

A.  HYDRAULIC  SUBSYSTEM  RECOMMENDATIONS 

The  primary  design  problem  for  this  actuator  is 
entrapment  and  removal  of  air  from  the  closed  hydraulic 
system.  Bleed  connections  were  established  at  system  high 
points,  but  great  difficulty  was  experienced  in  removing  all 
trapped  air  because  of  the  dead  ends  at  the  cylinder 
chambers.  Trapped  air  manifested  itself  as  a  small  region 
within  which  positioning  could  not  be  accomplished  on 
initial  start  of  motion.  Compression  of  the  trapped  air  was 
detected  as  a  slight  oscillation  or  spring  effect  at  the 
start  of  motion,  as  seen  in  the  graphs  in  Appendices  E  and 
F.  Its  presence  also  detracted  from  overall  system 
stiffness,  as  discussed  in  chapter  two.  Air  must  be 
prevented  from  entering  the  closed  system,  and  a  simple  and 
consistent  provision  should  be  made  for  its  removal,  should 
it  enter  the  system.  Improvements  which  could  help  this 
problem  are: 
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1.  Switch  from  a  petroleum  based  hydraulic  fluid  to  a 
water  based  or  water-glycol  hydraulic  fluid,  which  may 
have  a  lesser  tendency  to  entrain  air  bubbles  (LC) . 

2.  Install  bleed  connections  at  each  end  of  the  hydraulic 
cylinder  to  allow  bleeding  of  the  individual  cylinder 
chambers  (LC) . 

3.  Obtain  a  cylinder  with  more  effective  or  multiple  rod 
gland  seals  to  prevent  air  from  entering  past  this 
joint  (HC) . 

The  three  port  solenoid  valves  controlling  access  to  the 
hydraulic  orifices  limit  the  driving  force  air  supply 
pressure,  as  installed  in  their  present  configuration.  When 
the  air  cylinder  is  energized  in  the  raising  direction  with 
the  hydraulic  valves  closed,  a  point  can  be  reached  where 
the  valves  are  driven  off  their  seats  (from  fluid  pressure 
acting  beneath  the  seat)  causing  the  mechanism  to  move.  By 
increasing  the  air  supply  pressure,  the  force  on  the 
underside  of  the  valve  is  eventually  able  to  overcome  the 
force  of  the  internal  valve  springs,  and  the  valves  cannot 
stop  fluid  flow.  The  system  requires  that  the  control 
valves  for  the  orifices  have  the  characteristics  of  positive 
shut  off  in  both  directions  with  zero  leak  through.  Two 
solutions  to  this  limitation  are: 

1.  Install  another  solenoid  valve  between  chamber  4  of 
the  hydraulic  cylinder  and  the  parallel  arrangement  of 
control  valves,  oriented  so  that  it  would  open  against 
pressure  when  a  raising  motion  is  ordered  (LC) .  Minor 
software  changes  to  test  bed  operating  programs  would 
be  required  to  open  this  valve  during  every  movement 
of  the  mechanism  (NC) . 

2 .  Investigate  and  procure  other  valve  types  capable  of 
meeting  the  positive  shut  off,  no  leak  through 
criteria  (HC) . 
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The  Kaman  pressure  transducer  measuring  P5  was  subjected 
to  over-range  pressures  when  testing  the  higher  load 
conditions,  as  shown  by  the  five  pound  load,  lowering 
motion,  P5  strip  chart  included  in  Appendix  E  (worst  case 
from  a  pressure  standpoint).  The  manufacturer's  guarantee 
was  to  200  psi  and  the  average  transient  for  the  case  shown 
was  300  psi.  The  subject  transducer  was  calibrated  up  to 
this  high  pressure,  and  found  to  be  essentially  linear, 
however,  no  provision  for  pressure  measurement  was  available 
in  the  event  that  a  higher  air  supply  pressure  was  desired 
in  order  to  increase  the  load  capacity  of. the  system.  If 
hydraulic  pressure  measurements  are  necessary  in  a  next 
generation  actuator,  it  is  recommended  that  1000  psi 
transducers  be  installed  to  allow  flexibility  in  the  choice 
of  supply  pressure  (HC) . 

B.  PNEUMATIC  SUBSYSTEM  RECOMMENDATIONS 

The  five  port,  three  position  control  valve  performed 
well  in  the  control  of  the  air  cylinder.  The  only  reason  to 
change  from  this  configuration  would  be  if  another  choice  is 
more  suitable  from  the  standpoint  of  reliability.  Because 
of  its  essentially  "on  or  off"  nature,  the  system  as  a  whole 
was  subjected  to  the  full  air  supply  pressure  immediately 
after  air  valve  activation.  This  tended  to  magnify  the 
spring-like  effects  at  the  start  of  motion  due  to  entrained 
air  in  the  hydraulic  system,  and  possible  linkage  and 
foundation  deflections,  when  subject  to  the  full  force 
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translation  of  the  maximum  supply  pressure.  Investigations 
could  be  conducted  on  the  merits  of  using  a  proportional 
servo  valve  vice  the  present  control  valve  (HC) .  Major 
tradeoff  issues  would  be  possible  increases  in  component 
life  and  smoothness  of  operation  versus  added  complexity  of 
the  control  system  and  additional  computer  interface 
required  for  conversions  between  analog  and  digital  data. 

C.  CONTROL  SUBSYSTEM  RECOMMENDATIONS 

A  simple  four  point  discretization  to  the  chosen  gain 
curve  was  implemented  and  performed  well,  with  no 
perceptible  decrease  in  the  sample  and  order  rate  due  to  the 
logic  testing  statements.  It  is  recommended  that  a  series 
of  controllers  be  designed  to  take  advantage  of  more  of  the 
available  discrete  points  and  document  available  performance 
levels  with  the  existing  hardware  (NC) . 

As  described  in  Kuo  [Ref.  14],  speed  information  can  be 
extracted  from  the  encoder  data  by  a  simple  calculation. 
Addition  of  speed  information  feedback  to  the  automatic 
control  system  should  be  investigated  for  its  performance 
improvement  potential  (NC) . 

Data  from  the  pressure  transducers  offers  a  means  of 
load  sensing  which  can  be  used  to  tailor  the  actions  of  the 
controller.  This  could  also  be  accomplished  through  use  of 
strain  gages  placed  on  the  linkage  at  strategic  points.  The 
sophistication  of  the  control  scheme  could  be  increased 
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through  load  sensing  at  the  cost  of  more  interface  hardware 
(HC)  . 

D.  STRUCTURAL  IMPROVEMENT  RECOMMENDATIONS 

The  Novel  Actuator  Test  Bed  was  a  low  precision  machine 
built  to  test  concepts  and  designs.  Several  structural 
modifications  could  improve  the  accuracy  and  reliability  of 
the  mechanism; 

1.  Use  bearings  on  all  rotating  joints,  cylinder  pins, 
and  clevises  (HC) . 

2.  Devise  a  better  mount  for  the  optical  encoder  to  fix 
the  body  and  prevent  cable  wear  (LC) . 

3.  Statically  balance  the  linkage  arm  to  eliminate 
unnecessary  mechanism  loading  (LC) . 

As  stated  in  Reference  15,  linear  actuators  acting  on 
rotary  joints  are  less  desireable  because  the  effective 
power  transmission  ratio  varies  with  joint  position.  An 
actuator  with  a  configuration  similar  to  the  conceptual 
schematic  of  Figure  1  would  rectify  this  deficiency  (HC) . 

E.  SCOPE  OF  PROJECT  RECOMMENDATIONS 

The  results  of  the  Novel  Actuator  design  project  have 
proven  that  the  concept  has  a  great  deal  of  promise  for 
application  to  robotic  devices.  A  logical  extension  of  this 
project  is  to  implement  the  actuator  on  a  manipulator  with 
two  or  more  degrees  of  freedom  and  address  the  control 
issues  that  arise  from  that  application. 

Future  end  users  of  such  a  robotic  device  need  to  assist 
in  the  clarification  of  a  more  specific  design  goal.  A 
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trial  task  should  be  developed,  and  mobile  base  dynamics 
need  to  be  included  in  the  task  specification  so  that  their 
effects  on  the  system  may  be  dealt  with. 


58 


APPENDIX  A 


THEORETICAL  MODEL  SIMULATION  PROGRAMS 


TITLE  NOVEL  ACTUATOR  DYNAMICS  -  RAISING  MOVEMENT 
INITIAL 

D  REAL*8  P1,AP,AH,L11,L12,L13,W,THDOTO,THO,M, J 

D  REAL* 8  TERMl,TERM2,DELPH,AOH,PI,THDDOT,THDOT 

D  REAL*8  TH,LFP,LFH,LP,LH,BP,BH,ERR,WY,FPY,FHY 

D  REAL* 8  FP,FH,PHIP,PHIH,TM1,TM2,X1,X2,X1D0T,HCYL 

D  REAL* 8  PCYL,ETAP,ETAH,ALPHAP,ALPHAH,G,THDES,RHO 

D  REAL*8  CD,WLY,L14,WL 


CONST 

* 

PI  =  50.0, 

PS  I 

AP  =  0.8866, 
IN**2 

AH  =  0.1994 

IN**2 

CONST 

* 

if 

Lll  =  2.6235, 

IN. 

L12  =  2.635, 

IN. 

L13  =  14.980 

IN. 

CONST 

* 

★ 

W  =  5.0, 

LB. 

THDOTO  =0.0, 
RAD/S 

THO  =  -0.469398: 
RAD 

CONST 

* 

it 

LFP  =  10.3, 

IN. 

LFH  =  10.6, 

IN. 

LP  =  8.643 

IN. 

CONST 

* 

it 

LH  =  11.46, 

IN. 

L14  =  6.402, 

IN. 

WL  =  0.650 

LB. 

CONST 

* 

it 

G  =  0.004, 

ND 

THDES  =  .4341166 

RAD 

CONST 

RHO  =  0.0000808 

*  LB-SEC**2/IN**4 

* 

M  =  W 

* 


* 

★ 

J  = 

.1838  +  (.5823  * 
IN-LB-S**2 

* 

PI  = 

4.0  *  AT AN (1.0) 

* 

BP  = 

ACOS(L12/LFP) 

* 

BH  = 

ACOS (Lll/LFH) 

FP  = 

AP  *P1 

* 

CD  = 
CD  = 

.2513 
.  3803 
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*  CD  =  .3531 

*  CD  =  .2654 

DERIVATIVE 

NOSORT 

IF  (AOH  .EQ.  0.0)  GO  TO  10 

SORT 

WY  =  W  *  COS(TH) 

KLY  =  WL  *  COS(TH) 

FRY  =  FP  *  SIN(ALPHAP) 

FHY  -  FH  *  SIN(ALPHAH) 

FH  =  AH  *  DELPH 
PHIP  =  3P  +  TH 
PHIH  =  BH  -  TH 

TMl  =  LFH**2  +  Lll**2  -  2*LFH*L11*C0S (PHIH) 

TM2  =  LFP**2  +  L12**2  -  2*LFP*L12*COS (PHIP) 

XI  =  LH  -  TM1**0.5 
X2  =  TM2**0.5  -  LP 

XIDOT  =  (LFH*L11*THD0T*SIN (PHIH) ) *TM1** (-0.5) 
HCYL  =  LH  -  XI 
PCYL  =  LP  +  X2 

ETAP  =  ASIN( (LFP/PCYL)  *  SIN(PHIP)) 

ALPHAP  =  PI  -  ETAP 

ETAH  =  ASIN( (LFH/HCYL)  *  SIN(PHIH)) 

ALPHAH  =  PI  -  ETAH 

DELPH  =  (AH*X1D0T/(CD*A0H*(2/RH0) **.5) ) **2 
THDDOT  =  (1. 0/J) * (FPY*L12  -  FHY*L11  -  WY*L13  - 
&WLY* (L14+L12) ) 

THDOT  =  INTGRL(THDOTO, THDDOT) 

GO  TO  20 
THDDOT  =0.0 
THDOT  =0.0 
DELPH  =0.0 

TH  =  INTGRL(THO, THDOT) 

T2DDEG  =  THDDOT  *  (180.0/PI) 

TIDDEG  =  THDOT  *  (180.0/PI) 

TDEG  =  TH  *  (180.0/PI) 

ERR  =  THDES  -  TH 

AOH  =  G  *  ERR 

AOH  =  .0001917  *  STEP(.030) 

AOH  =  .0003801  *  STEP(.030) 

AOH  =  .000767  *  STEP(.030) 

AOH  =  .0014522  *  STEP(.030) 

IF  (TH  .GE.  0.4341166)  CALL  ENDRUN 
IF  (ERR  .LE.  .005)  CALL  ENDRUN 

TERMINAL 

CONTRL  FINTIM  =  10.0,DELT  =  .005 

SAVE  . 01 , T2DDEG , TIDDEG , TDEG , DELPH , AOH , XIDOT , XI , X2 
PRINT  . 1, TDEG, TIDDEG, XI, XIDOT 


NOSORT 

10 


SORT 

20 


DYNAMIC 


* 

* 

* 

* 

* 
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END 

PARAM  G  =  0.003 
END 

PARAM  G  =  0,002 
END 

PARAM  G  =  0.001 
END 

PARAM  G  =  0.0005 
END 

GRAPH (DE=TEK6 18)  TIME,TDEG 
GRAPH (DE=TEK6 18)  TIME,DELPH 


END 


STOP 
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TITLE  NOVEL  ACTUATOR  DYNAMICS  -  LOWERING  MOVEMENT 
INITIAL 

D  REAL*8  P1,AP,AH,L11,L12,L13,W,THDOTO,THO,M, J 

D  REAL*8  TERMl,TERM2,DELPH,AOH,PI,THDDOT,THDOT 

D  REAL*8  TH,LFP,LFH,LP,LH,BP,BH,Wy,FPY,FHY,FP 

D  REAL*8  FH,PHIP,PHIH,TM1,TM2,X1,X2,X1D0T,HCYL 

D  REAL* 8  PCYL,ETAP,ETAH,ALPHAP,ALPHAH,G,THDES 

D  REAL*8  RHO,CD,WLY,L14,WL 


IN**2 


CONST 

* 

■It 

PI  =  50.0, 

PS  I 

AP  =  0.8099, 
IN**2 

AH  ^ 

CONST 

* 

* 

Lll  =  2.6235, 
IN. 

L12  =  2.635, 

IN. 

L13 

CONST 

* 

* 

W  =  2.0, 

LB. 

THDOTO  =  0.0, 
RAD/S 

THi 

CONST 

* 

* 

LFP  =  10.3, 

IN. 

LFH  =  10.6, 

IN. 

LP 

CONST 

* 

* 

LH  =  11.46, 

IN. 

L14  =  6.402, 

IN. 

WL 

CONST 

■k 

G  =  .006, 

ND 

THDES  =  -.4693981 
RAD 

* 

CONST 

* 


RHO  =  0.0000808 
LB-SEC**2/IN**4 


M  =  W 


J  = 

= 

.1838  +  (.5823  * 

* 

* 

IN-LB-S**2 

* 

PI 

= 

4.0  *  ATAN(l.O) 

* 

BP 

ACOS (L12/LFP) 

* 

BH 

= 

ACOS (Lll/ LFH) 

* 

FP 

AP  *P1 

* 

CD 

= 

.  5081 

* 

CD 

= 

.  6726 

* 

CD 

.  6333 

* 

CD 

— 

.4251 

DERIVATIVE 

NOSORT 

IF  (AOH  .EQ.  0.0)  GO  TO  10 

SORT 

WY  =  W  *  COS(TH) 

WLY  =  WL  *  COS(TH) 
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FPY  =  FP  *  SIN(ALPHAP) 

FHY  =  FH  *  SIN(ALPHAH) 

FH  =  AH  *  DELPH 
PHIP  =  BP  +  TH 
PHIH  =  BH  -  TH 

TMl  =  LFH**2  +  Lll**2  -  2*LFH*L11*C0S (PHIH) 

TM2  =  LFP**2  +  L12**2  -  2*LFP*L12*COS (PHIP) 

XI  =  LH  -  TM1**0.5 
X2  =  TM2**0.5  -  LP 

XIDOT  =  (LFH*Lll*THDOT*SIN(PHIH) )*TMl**(-0.5) 
HCYL  =  LH  -  XI 
PCYL  =  LP  +  X2 

ETAP  =  ASIN( (LFP/PCYL)  *  SIN(PHIP)) 

ALPHAP  =  PI  -  ETAP 

ETAH  =  ASIN( (LFH/HCYL)  *  SIN(PHIH)) 

ALPHAH  =  PI  -  ETAH 

DELPH  =  (AH*X1D0T/(CD*A0H*(2/RH0)**.5))**2 
THDDOT  =  (1.0/J) *(FHY*L11  -  FPY*L12  -  WY*L13  - 
&WLY* (L14+L12) ) 

THDOT  =  INTGRL(THDOTO, THDDOT) 

NOSORT 

GO  TO  20 

10  THDDOT  =0.0 

THDOT  =0.0 
DELPH  =0.0 

SORT 

20  TH  =  INTGRL(THO, THDOT) 

T2DDEG  =  THDDOT  *  (180.0/PI) 

TIDDEG  =  THDOT  *  (180.0/PI) 

TDEG  =  TH  *  (180.0/PI) 

DYNAMIC 

*  AOH  =  G  *  (TH  -  THDES) 

*  AOH  =  .0001917  *  STEP(.030) 

*  AOH  =  .0003801  *  STEP(.030) 

*  AOH  =  .000767  *  STEP(.030) 

AOH  =  .0014522  *  STEP(.030) 

IF  (TH  .LE.  -0.4693981)  CALL  ENDRUN 

TERMINAL 

CONTRL  FINTIM  =  10.0,DELT  =  .0001 

SAVE  .001, T2  DDEG , TIDDEG , TDEG , DELPH , AOH , XIDOT , XI , X2 

PRINT  . 01, TDEG, TIDDEG, XI, XIDOT 

*END 

*PARAM  G  =  0.005 
*END 

*PARAM  G  =  0.004 
*END 

*PARAM  G  =  0.003 
*END 

*PARAM  G  =  0.002 
♦END 

♦PARAM  G  =  0.001 
♦END 

♦PARAM  G  =  0.0005 


*END 

♦GRAPH (DE 
♦GRAPH (DE 
END 
STOP 


TEK618)  TIME,T1DDEG,TDEG 
TEK618)  TIME,DELPH 
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APPENDIX  B 


SOLENOID  VALVE  COMPUTER  INTERFACE 


A  schematic  diagram  of  the  electrical  connections  and 
components  used  to  provide  an  interface  between  the  IBM  PC 
and  the  pneumatic  and  hydraulic  solenoid  valves  is  shown  in 
Figure  B-1. 
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Valve/Computer  Interface 


APPENDIX  C 


HYDRAULIC  PRESSURE  TRANSDUCER  CALIBRATION  DATA 

Results  of  the  calibration  of  the  two  channel  Kaman 
pressure  transducers  are  presented  in  the  following  table 
and  graphically  in  Figure  C-1.  Channel  A  was  used  to 
measure  P5  and  channel  B  measured  P^,. 


TABLE  C-1 


PRESSURE  TRANSDUCER  DATA 


Reference  Standard 
Pressure 


Channel  A 
Pressure 


Channel  B 
Pressure 


0.0 

10,0 

20.0 

30.0 

40.0 

50.0 

60.0 

70.0 

80.0 

90.0 

100.0 

110.0 

120.0 

130.0 

140.0 

150.0 

160.0 

170.0 

180.0 

200.0 

225.0 

250.0 

275.0 

300.0 


0.0 

9.9 

19.8 

29.8 

39.7 

49.7 

59.6 

69.8 

79.7 

89.8 
100.0 
110.2 

120.3 

130.4 
140.6 

150.8 

160.9 
171.0 
181.0 
203.0 
227.0 
253.0 
278.0 
303.0 


-0.35 

9.6 

19.4 

29.4 

39.3 

49.3 
59.2 

69 . 4 

79.4 

89.5 
99.8 

109.9 
120.1 

130.3 

140.4 
150.6 

160.9 
171.0 
181.0 
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X  CHANNEL  A 
D  CHANNEL  B 


APPENDIX  D 


DATA  ACQUISITION  PROGRAMS 


TESTOP.BAS 

THIS  PROGRAM  WAS  CREATED  TO  TEST  THE  OPERATION  OF  THE 
NOVEL  ACTUATOR  TEST  BED,  AND  GATHER  DATA  FOR  MODEL 
VERIFICATION.  WRITTEN  10-27-88 

JDI. 


'  LOCATE  INTERFACE  BOARD  PORTS 

I 

C  =  &H330  ;  P  =  C  +  3  :  SOLENOIDS  =  C  +  1 

I 

'  CLEAR  COUNTERS 


OUT  C,0 

I 

'  SET  VALVE  PORT  TO  CLOSE  ALL  SOLENOIDS 

I 

OUT  SOLENOIDS, 255 

I 

'  DIMENSION  ARRAY  TO  STORE  TIME  AND  ENCODER  DATA 


OPTION  BASE  1 
DIM  POSIDAT(2500,2) 

I 

'  DETERMINE  TYPE  OF  MOVE 

I 

100  PRINT  "ENTER  1  FOR  RAISE,  2  FOR  LOWER,  0  TO  HALT 
PROGRAM" 

INPUT  AORDER% 

CLS 

IF  AORDER%  =  0  THEN  GOTO  400 
AV%  =  AORDER% 

I 

'  SPEED  SELECTION  -  CREATE  HYDRAULIC  VALVE  TABLE 

I 

HV1%  =  32  :  HV2%  =  16 
HV3%  =  8  ;  HV4%  =  4 

• 

'  SELECT  ORIFICES  TO  OPEN 

I 

200  PRINT  "ENTER  A  FOUR  DIGIT  NUMBER  CONSISTING  OF" 

PRINT  "I'S  AND  O'S,  1  FOR  OPEN  AND  0  FOR  CLOSED," 

PRINT  "FOR  VALVES  1  THROUGH  4  CONSECUTIVELY." 

INPUT  HORDER% 
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IF  HORDER%  =  0001  THEN 
HV%  =  HV1% 

PRINT  "OPENING  ORIFICE  1" 

ELSEIF  HORDER%  =  0010  THEN 
HV%  =  HV2% 

PRINT  "OPENING  ORIFICE  2" 

ELSEIF  HORDER%  =  0011  THEN 
HV%  =  HV1%  OR  HV2% 

PRINT  "OPENING  ORIFICES  1  AND  2" 

ELSEIF  HORDER%  =  0100  THEN 
HV%  =  HV3% 

PRINT  "OPENING  ORIFICE  3" 

ELSEIF  HORDER%  =  0101  THEN 
HV%  =  HV3%  OR  HV1% 

PRINT  "OPENING  ORIFICES  1  AND  3" 

ELSEIF  HORDER%  =  0110  THEN 
HV%  =  HV3%  OR  HV2% 

PRINT  "OPENING  ORIFICES  2  AND  3" 

ELSEIF  HORDER%  =  0111  THEN 

HV%  =  HV3%  OR  HV2%  OR  HV1% 

PRINT  "OPENING  ORIFICES  1,  2,  AND  3" 
ELSEIF  HORDER%  =  1000  THEN 
HV%  =  HV4% 

PRINT  "OPENING  ORIFICE  4" 

ELSEIF  HORDER%  =  1001  THEN 
HV%  =  HV4%  OR  HV1% 

PRINT  "OPENING  ORIFICES  1  AND  4" 

ELSEIF  HORDER%  =  1010  THEN 
HV%  =  HV4%  OR  HV2% 

PRINT  "OPENING  ORIFICES  2  AND  4" 

ELSEIF  HORDER%  =  1011  THEN 

HV%  =  HV4%  OR  HV2%  OR  HV1% 

PRINT  "OPENING  ORIFICES  1,  2,  AND  4" 
ELSEIF  HORDER%  =  1100  THEN 
HV%  =  HV4%  OR  HV3% 

PRINT  "OPENING  ORIFICES  3  AND  4" 

ELSEIF  HORDER%  =  1101  THEN 

HV%  =  HV4%  OR  HV3%  OR  HV1% 

PRINT  "OPENING  ORIFICES  1,  3,  AND  4" 
ELSEIF  HORDER%  =  1110  THEN 

HV%  =  HV4%  OR  HV3%  OR  HV2% 

PRINT  "OPENING  ORIFICES  2,  3,  AND  4" 
ELSEIF  HORDER%  =  1111  THEN 

HV%  =  HV4%  OR  HV3%  OR  HV2%  OR  HV1% 
PRINT  "OPENING  ORIFICES  1,  2,  3,  AND  4" 

ELSE 

GOTO  200 
END  IF 
PRINT 

PRINT  "STOP  MOVE  BY  PRESSING  KILL  SWITCH" 
STARTLOOP  =  1 

I 

'  RECORD  INITIAL  ENCODER  VALUE 
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COPY  ENCODER  COUNTERS  TO  HOLDING  REGISTERS 


OUT  C ,  1 


SELECT  COUNTER  X  REGISTER 


OUT  P,1 


'  BEGIN  LOOP  FOR  INPUT 

t 

FOR  I  =  1  TO  6 

X(I)  =  INP(C) 

NEXT  I 

I 

'  CONVERT  TO  DECIMAL  VALUE 

I 

XV=X(6)+X{5) *16+X(4) *256+X(3)*4096+X(2) *65536!+X(l) *1048576! 

I 

'  SET  FOR  A  PLUS/MINUS  READING 

I 

IF  XV>8388607!  THEN  XV=XV-1 . 677722E+07 . 

POSIDAT(l,2)  =  XV 

I 

'  COMBINE  AIR  AND  HYD  VALVE  ORDERS 

I 

ORDER%  =  AV%  OR  HV% 

I 

'  HARDWARE  INTERFACE  USES  NEGATIVE  TRUE  LOGIC... 

'  NEGATE  MOVEMENT  ORDER  AND  SEND  OUT  TO  SOLENOIDS 


NORDER%  =  NOT(ORDER%)  AND  &HFF 

POSIDAT(l,l)  =0.0 

MTIMER 

OUT  SOLENOIDS, NORDER% 


'  RECORD  THE  ENCODER  AND  TIME  VALUES  DURING  THE 

MOVE 

I 

COUNT%  =  2 

DO  WHILE  STARTLOOP  =  1 

POSIDAT(COUNT%, 1)  =  MTIMER/1E6 
OUT  C,1 
OUT  P, 1 
MTIMER 

FOR  I  =  1  TO  6 

X(I)  =  INP(C) 

NEXT  I 

XV=X(6)+X(5) *16+X(4) *256+X(3) *4096+X(2) *65536!+X(l) *1048576! 
IF  XV>8388607!  THEN  XV=XV-1 . 677722E+07 
POSIDAT(COUNT%,2)  =  XV 
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INCR  COUNT% 

A  =  INP(&H331)  AND  16 
IF  A  =  0  THEN  GOTO  300 

LOOP 

300  OUT  SOLENOIDS, 255 
TICK%  =  COUNT %  -  1 
PRINT 

PRINT  "THE  NUMBER  OF  ENCODER  READS  WAS";TICK% 

POSIT  =  POSIDAT(TICK%,2) 

PRINT  "NEW  POSITION  IS"; POSIT 
PRINT  "SEND  DATA  TO  A  FILE(Y  OR  N)?" 

INPUT  Q$ 

IF  Q$  =  "N"  THEN  GOTO  100 

PRINT  "ENTER  DOS  FILENAME  FOR  DATA  OUTPUT" 

INPUT  DATAFILE $ 

OPEN  DATAFILE$  FOR  APPEND  AS  #1 
PRINT  #1,  TICK% 

FOR  I  =  1  TO  TICK% 

PRINT  #1, USING  "########. ###^i#";POSIDAT(1, 1)  ,POSIDAT(I, 2) 
NEXT  I 
CLOSE  #1 
GOTO  100 
400  END 
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MANIP.BAS 


'  THIS  PROGRAM  WAS  CREATED  TO  MANIPULATE  THE  TEST  DATA 
•  GENERATED  BY  THE  TESTOP.BAS  PROGRAM  FOR  DYNAMIC 
'  MODEL  VERIFICATION. 

'  JDI  11/12/88. 

I 

100  PRINT  "RUN  DATA  MANIPULATION  PROGRAM (1  =  Y,  2  =  N)? 
INPUT  Q1 

IF  Q1  <>  1  THEN  GOTO  300 
CLS 

PRINT  "THIS  PROGRAM  MANIPULATES  ENCODER  DATA  ACQUIRED" 

PRINT  "USING  TESTOP.BAS" 

PRINT 

PRINT  "ENTER  THE  DOS  FILENAME  OF  THE  DATA  FILE" 

INPUT  DATAFILE $ 

OPEN  DATAFILES  FOR  INPUT  AS  #1 
INPUT  #l,COUNT% 

I 

'  DIMENSION  ARRAYS  TO  MANIPULATE  ENCODER  DATA 

I 

OPTION  BASE  1 

DIM  POSIDAT(COUNT%,9) 

I 

'  READ  DELTA  T  AND  ENCODER  POSITS  FROM  DOS  FILE 

I 

FOR  I  =  1  TO  COUNT% 

INPUT  #l,POSIDAT(I,l) 

INPUT  #l,POSIDAT(I,2) 

NEXT  I 
CLOSE  #1 

I 

'  DEFINE  PI  FOR  CONVERSION  OF  COUNTS  TO  RADIANS 

I 

PI  =  4.0  *  ATN(l.O) 

I 

'  ADD  UP  THE  TIME  INCREMENTS  FOR  ELAPSED  TIME, 

'  COMPUTE  POSITIONS  AND  INSTANTANEOUS  VELOCITIES 

'  IN  TERMS  OF  DEGREES  OF  MOTION  THETA  AND 

'  DISPLACEMENT  OF  THE  HYDRAULIC  PISTON  XI,  AND 

'  SEND  THE  STORED  DATA  TO  A  SEQUENTIAL  FILE 

I 

POSIDAT(l,3)  =0.0 

POSIDAT(l,4)  =  POSIDAT(l,2)  *  ( (2 . 0*PI ) / ( 8192 . 0) ) 
POSIDAT(l,5)  =  POSIDAT(l,4)  -  0.4693981 
POSIDAT(l,6)  =  POSIDAT(l,5)  *  180.0/PI 
POSIDAT(l,7)  =0.0 

Cl  =  119.24275  -  55.6182*COS(1.320697-POSIDAT(1,5) ) 
POSIDAT(l,8)  =  11.460  -  (Cl"(0.5)) 

POSIDAT(l,9)  =0.0 
FOR  I  =  2  TO  COUNT % 

J  =  I  -  1 

POSIDAT(I,3)  =  POSIDAT(I,l)  +  POSIDAT(J,3) 
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P0SIDAT(I,4)  =  P0SIDAT(I,2)  *  ( ( 2 . 0*PI ) / ( 8 192 . 0 ) ) 

P0SIDAT(I,5)  =  P0SIDAT(I,4)  -  0.4693981 

POSIDAT(I,6)  =  POSIDAT(I,5)  *  180.0/PI 

DELTATHETA  =  POSIDAT(I,6)  -  POSIDAT(J,6) 

DELTAT  =  POS I DAT (1,1) 

IF  DELTAT  =0.0  THEN 
POSIDAT(I,7)  =0.0 

ELSE 

POSIDAT(I,7)  =  ABS(DELTATHETA/DELTAT) 

END  IF 

Cl  =  119.24275  -  55.6182*COS(1.320697-POSIDAT(I,5) ) 
POSIDAT(I,8)  =  11.460  -  (Cl^(0.5)) 

DELTAXl  =  POSIDAT(I,8)  -  POSIDAT(J,8) 

IF  DELTAT  =  0.0  THEN 
POSIDAT(I,9)  =  0.0 

ELSE 

POSIDAT(I,9)  =  ABS(DELTAX1/DELTAT) 

END  IF 
NEXT  I 
PRINT 

PRINT  "SEND  DATA  TO  A  FILE(1  =  Y,  0  =  N)?" 

INPUT  Q2 

IF  Q2  <>  1  THEN  GOTO  200 

PRINT  "ENTER  DOS  FILENAME  FOR  DATA  OUTPUT" 

INPUT  MANFILES 

OPEN  MANFILE$  FOR  APPEND  AS  #2 


PRINT 

#2," 

TIME" ;" 

THETA" ;" 

THETADOT" ; 

PRINT 

#2," 

XI"  ;" 

XIDOT" 

PRINT 

#2, 

FOR  I 

=  1  TO 

COUNT % 

PRINT  #2, USING  "#######.#####"; POSIDAT ( I , 3 ), POSIDAT ( I , 6) 
PRINT  #2, USING  "#######.#####"; POSIDAT ( I , 7 ), POSIDAT ( I , 8 ) 
PRINT  #2, USING  "#######.#####"; POSIDAT ( I , 9 ) 

NEXT  I 
CLOSE  #2 
ERASE  POSIDAT 
GOTO  100 

200  PRINT  "  TIME"-"  THETA";"  THETADOT"; 

PRINT  "  XI";"  XIDOT" 

PRINT 


FOR  I  =  1  TO  COUNT % 


PRINT  USING  "#######. #####";POSIDAT(I, 3) ,POSIDAT(I, 6) ; 
PRINT  USING  "#######. #####";POSIDAT(I, 7) ,POSIDAT(I, 8) ; 
PRINT  USING  "#######. #####";POSIDAT(I, 9) 

NEXT  I 


ERASE  POSIDAT 


GOTO  100 


300  END 
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* 

* 


MANIP  FORTRAN  A1 


* 
* 

*  THIS  PROGRAM  WAS  CREATED  TO  MANIPULATE  THE  TEST  DATA  * 

*  GENERATED  BY  THE  TESTOP.BAS  PROGRAM  FOR  DYNAMIC  MODEL  * 

*  VERIFICATION.  FORTRAN  VERSION  FOR  MAINFRAME  USE  TO  * 

*  MANIPULATE  FILES  LARGER  THAN  PC  CAN  HANDLE.  * 

*  JDI  11/12/88.  * 

* 

REAL  PI,C1,DTH,DT,DX1,A,B,C,D,E 
INTEGER  I , J , Q1 , Q2 , COUNT 
DIMENSION  POSDAT(5000,9) 

100  PRINT  *, 'YOU  MUST  HAVE  THE  DATA  TO  BE  WORKED  ON  IN  A 
&FILE' 

PRINT  *, 'CALLED  "FILE  NOVEL  Al"  ON  YOUR  DISK.' 

PRINT  *,'RUN  DATA  MANIPULATION  PROGRAM (1  =  Y,  2  =  N)?' 
READ  *,  Q1 

IF  (Q1  .NE.  1)  GO  TO  800 
PRINT  * 

PRINT  *,'THIS  PROGRAM  MANIPULATES  ENCODER  DATA 
^ACQUIRED ' 

PRINT  *, 'USING  TESTOP.BAS' 

PRINT  * 

OPEN  (UNIT  =  10,  FILE  =  'NOVEL',  STATUS  =  'OLD') 

READ  (10,*)  COUNT 

* 

*  READ  DELTA  T  AND  ENCODER  POSITS  FROM  RAW  DATA 

*  FILE 

* 

DO  200  I  =  1, COUNT 

READ(10, *)  POSDAT(I, 1) ,POSDAT(I,2) 

200  CONTINUE 

CLOSE  (10) 

* 

*  DEFINE  PI  FOR  CONVERSION  OF  COUNTS  TO  RADIANS 

* 

PI  =  4.0  *  ATAN(l.O) 

* 

*  ADD  UP  THE  TIME  INCREMENTS  FOR  ELAPSED  TIME, 

*  COMPUTE  POSITIONS  AND  INSTANTANEOUS  VELOCITIES 

*  IN  TERMS  OF  DEGREES  OF  MOTION  THETA  AND 

*  DISPLACEMENT  OF  THE  HYDRAULIC  PISTON  XI,  AND 

*  SEND  THE  STORED  DATA  TO  A  SEQUENTIAL  FILE 

* 

POSDAT(l,3)  =0.0 

POSDAT(l,4)  =  POSDAT(l,2)  *  ( (2 . 0*PI) / (8192 . 0) ) 
POSDAT(l,5)  =  POSDAT(l,4)  -  0.4693981 
POSDAT(l,6)  =  POSDAT(l,5)  *  180.0/PI 
POSDAT(l,7)  =0.0 

Cl  =  119.24275  -  55.6182*COS(1.320697-POSDAT(1,5) ) 
POSDAT(l,8)  =  11.460  -  (Cl**(0.5)) 

POSDAT(l,9)  =0.0 


DO  300  I  =  2, COUNT 
J  =  I  -  1 

POSDAT(I,3)  =  POSDAT(I,l)  +  POSDAT(J,3) 

POSDAT(I,4)  =  POSDAT(I,2)  *  ( ( 2 . 0*PI ) / (8192 . 0) ) 
POSDAT(I,5)  =  POSDAT(I,4)  -  0.4693981 
POSDAT(l,6)  =  POSDAT(I,5)  *  180.0/Pl 
DTK  =  POSDAT(l,6)  -  POSDAT(J,6) 

DT  =  POSDAT(l,l) 

IF  (DT  .EQ.  0.0)  THEN 
POSDAT(l,7)  =0.0 
ELSE 

POSDAT(l,7)  =  ABS(DTH/DT) 

END  IF 

Cl  =  119.24275  -  55.6182*COS(1.320697-POSDAT(1,5) ) 
POSDAT(l,8)  =  11.460  -  (Cl**(0.5)) 

DXl  =  POSDAT(l,8)  -  POSDAT(J,8) 

IF  (DT  .EQ.  0.0)  THEN 
POSDAT(l,9)  =0.0 
ELSE 

POSDAT(l,9)  =  ABS(DX1/DT) 

END  IF 
CONTINUE 
PRINT  * 

PRINT  *, 'SEND  DATA  TO  A  F1LE(1  =  Y,  0  =  N) ? ' 

READ  *,Q2 

IF  (Q2  .NE.  1)  GO  TO  600 

PRINT  *, 'OUTPUT  IS  IN  A  FILE  NAMED  "FILE  PRCSSD  Al"  ' 
OPEN  (UNIT  =  20,  FILE  =  'PRCSSD',  STATUS  =  'NEW') 
WRITE (20,*) •  TIME ' , '  THETA ' , '  THETADOT ' 

t'  XI','  XIDOT' 

WR1TE(20, *) 

F0RMAT(1X,5F12.5) 

DC  500  1  =  1, COUNT 
A  =  POSDAT(l,3) 

B  =  POSDAT(l,6) 

C  =  POSDAT(l,7) 

D  =  POSDAT(l,8) 

E  =  POSDAT(l,9) 

WR1TE(20, 400)  A,B,C,D,E 
CONTINUE 
CLOSE  (20) 

GOTO  800 

PRINT  * , '  TIME ' , •  THETA ' , '  THETADOT ' 

'  XI','  XIDOT' 

PRINT  * 

DO  700  1  =  1, COUNT 
A  =  POSDAT(l,3) 

B  =  POSDAT(l,6) 

C  =  POSDAT(l,7) 

D  =  POSDAT(l,8) 

E  =  POSDAT(l,9) 

WR1TE(*,400)  A,B,C,D,E 


700  CONTINUE 
800  END 
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APPENDIX  E 


HYDRAULIC  PRESSURE  STRIP  CHART  RECORDINGS 

Recordings  of  the  hydraulic  pressure  difference  for 
raising  and  lowering  motions  and  the  load  conditions  of  no 
load,  two  pounds,  and  five  pounds  are  shown  in  Figures  E-1 
through  E-12.  The  worst  case  pressure  reading  for  orifice 
one,  five  pound  load,  lowering  motion,  is  shown  as  Figure 
E-13  . 
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Figure  E-1  Pressure  Difference,  No  Load,  Orifice  1. 
Top  Lowering,  Bottom  Raising 


Figure  E-2  Pressure  Difference,  No  Load,  Orifice  2. 
Top  Lowering,  Bottom  Raising 
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• 

1 

Figure  E-3  Pressure  Difference, 

No  Load,  Orifice  3. 

Top  Lowering,  Bottom 

Raising 
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Figure  E-4  Pressure  Difference,  No  Load,  Orifice  4. 
Top  Lowering,  Bottom  Raising 


82 


Figure  E-5  Pressure  Difference,  2  Lb  Load,  Orifice  1. 
Top  Lowering,  Bottom  Raising 
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Figure  E-6  Pressure  Difference,  2  Lb  Load,  Orifice  2. 
Top  Lowering,  Bottom  Raising 


84 


I 


Figure  E-7  Pressure  Difference,  2  Lb  Load, 
Top  Lowering,  Bottom  Raising 


Orifice  3. 
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igure  E- 


8  Pressure  Difference,  2  Lb  Load,  Orifice  4. 
Top  Lowering,  Bottom  Raising 
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Figure  E- 
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Pressure  Difference,  5  Lb  Load,  Orifice 
Top  Lowering,  Bottor.  Raising 
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Figure  E-10  Pressure  Difference,  5  Lb  Load, 
Top  Lowering,  Bottom  Raising 


Orifice  2. 
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3 
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Figure  E-11  Pressure  Difference,  5  Lb  Load,  Orifice  3. 
Top  Lowering,  Bottom  Raising 
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Figure  E-12  Pressure  Difference,  5  Lb  Load,  Orifice  4. 
Top  Lowering,  Bottom  Raising 
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-13 


Cylinder  Pressures,  5  Lb  Load, 
Lowering.  Top  P^,  Bottoin  Pg 


J 

Orifice  1, 
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APPENDIX  F 


HYDRAULIC  PISTON  POSITION  VERSUS  TIME 

Figures  F-1  through  F-12  represent  hydraulic  piston 
position  Xi  versus  time  for  each  orifice  under  the  specified 
load  conditions.  The  zero  position  for  coordinate  was 
taken  to  be  when  the  Novel  Actuator  Test  Bed  mechanism  was 
in  the  fully  lowered  position,  and  the  hydraulic  cylinder 
rod  was  at  its  maximum  extension.  Accordingly,  raising 
motions  are  indicated  by  curves  with  negative  slope,  and 
lowering  motions  are  curves  with  positive  slopes. 
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HYD  PISTON  POSIT.  X1.  INCHES 


9-; 


0.00 


0.40 


0.80  1.20 

TIME,  SECONDS 


Figure  F-6  2  Lb  Load,  Orifice  2 


TIME,  SECONDS 


Figure  F-8  2  Lob  Load,  Orifice  4 


100 


TIME.  SECONDS 


Figure  F-10  5  Lb  Load,  Orifice  2 
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APPENDIX  G 


AUTOMATIC  COMPUTER  CONTROL  PROGRAMS 


CONTROL. BAS 

THIS  PROGRAM  POSITIONS  THE  NOVEL  ACTUATOR  TEST  BED 
MECHANISM  IN  RESPONSE  TO  A  GIVEN  POSITION  ORDER. 

JDI  11/11/88 


C  =  &H330  :  P  =  C  +  3  :  SOLENOIDS  =  C  +  1 
OUT  C,0 

OUT  SOLENOIDS, 255 
OPTION  BASE  1 
DIM  POSIDAT(1500,3) 

100  OUT  C,1 
OUT  P,1 

FOR  I  =  1  TO  6 
X(I)  =  INP(C) 

NEXT  I 

XV=X(6)+X(5) *16+X(4) *256+X(3) *4096+X(2) *655361+X(1) *1048576 
IF  XV>8388607!  THEN  XV=XV-1 . 677722E+07 
POSIDAT(l,2)  =  XV 

200  PRINT  “RUN  AUTOMATIC  CONTROLLER ( l=y ES, 0=NO) ?” 

INPUT  PROG% 

CLS 

IF  PROG%  *  0  THEN  GOTO  800 

PRINT  "CURRENT  POSITION  IS";XV 

PRINT  "ENTER  A  POSITION  ORDER  FROM  0  TO  1170" 

PRINT  "(MUST  BE  AN  INTEGER  AND  AT  LEAST  200  AWAY  FROM 
CURRENT" ; 

PRINT  "  POSITION) " 

INPUT  POSORD 
E  =  POSORD  -  XV 
MAGERR  =  ABS(E) 

IF  POSORD  <  0  OR  POSORD  >  1170  THEN  GOTO  200 

IF  MAGERR  <  200  THEN  GOTO  200 

IF  E  >  0  THEN  GOTO  300 

IF  E  <  0  THEN  GOTO  400 

300  AV%  =  1 

GOTO  500 

400  AV%  =  2 

I 

'  INITIAL  MOVEMENT  ORDER  DECISIONS 

• 

500  IF  MAGERR  >  724  THEN  HV%  =  4 

IF  MAGERR  <  724  AND  MAGERR  >  374  THEN  HV%  =  8 

IF  MAGERR  <  374  AND  MAGERR  >  187  THEN  HV%  =  16 


IF  MAGERR  <  187  THEN  HV%  =  32 
ORDER%  =  AV%  OR  HV% 

NORDERI  =  NOT(ORDER%)  AND  &HFF 

STARTLOOP  =  1 

COUNT%  =  2 

POSIDAT(l,l)  =0.0 

MTIMER 

OUT  SOLENOIDS, NORDER% 

DO  WHILE  STARTLOOP  =  1 

POSIDAT(COUNT%, 1)  =  MTIMER/1E6 
OUT  C,1 
OUT  P,1 
MTIMER 

FOR  I  =  1  TO  6 

X(I)  =  INP(C) 

NEXT  I 

XV=X(6)+X(5) *16+X(4) *256+X(3) *4096+X(2) *65536!+X(l) *1048576 
IF  XV>8388607!  THEN  XV=XV-1 . 677722E+07 
POSIDAT(COUNT%,2)  =  XV 
E  =  POSORD  -  XV 
MAGERR  =  ABS(E) 

IF  MAGERR  >  724  THEN  HV%  =  4 

IF  MAGERR  <  724  AND  MAGERR  >  374  THEN  HV%  =  8 

IF  MAGERR  <  374  AND  MAGERR  >  187  THEN  HV%  =  16 

IF  MAGERR  <  187  AND  MAGERR  >  10  THEN  HV%  =  32 

ORDER%  =  AV%  OR  HV% 

NORDER%  =  NOT(ORDER%)  AND  &HFF 
OUT  SOLENOIDS, NORDER% 

IF  MAGERR  <10  THEN  GOTO  600 
A  =  INP(&H331)  AND  16 
IF  A  =  0  THEN  GOTO  700 
INCR  COUNT% 

LOOP 

600  OUT  SOLENOIDS, 255 
POSIDAT(l,3)  =  0.0 
FOR  I  =  2  TO  COUNT% 

J  =  I  -  1 

POSIDAT(I,3)=  POSIDAT(I,l)  +  POSIDAT(J,3) 

NEXT  I 
PRINT 

PRINT  "SEND  DATA  TO  A  FILE(l)  OR  TO  THE  SCREEN(2)?" 

PRINT  "(IF  NO  DATA  DESIRED,  ENTER  ANYTHING  ELSE) 

INPUT  DD% 

IF  DD%  =  1  THEN  GOTO  605 
IF  DD%  =  2  THEN  GOTO  610 
IF  DD%  <>  1  OR  2  THEN  GOTO  200 

605  PRINT  "ENTER  DOS  FILENAME  FOR  DATA  OUTPUT" 

INPUT  DATAFILE$ 

OPEN  DATAFILE $  FOR  APPEND  AS  #1 
PRINT  #1,"  TIME";"  POSIT" 

PRINT  #1, 

FOR  I  =  1  TO  COUNT% 

PRINT  #1,  USING  "#####.#####";POSIDAT(I,3) ,POSIDAT(I,2) 


NEXT  I 
CLOSE  #1 

610  PRINT  "  TIME";"  POSIT" 

PRINT 

FOR  I  =  1  TO  COUNT % 

PRINT  USING  "#####.#####";POSIDAT(I,3) ,POSIDAT(I,2) 
NEXT  I 
GOTO  200 

700  OUT  SOLENOIDS, 255 

PRINT  "CONTROL  PROGRAM  ABORT" 

GOTO  200 
800  END 
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STOW. BAS 


THIS  PROGRAM  CAN  BE  USED  TO  PLACE  THE  NOVEL  ACTUATOR  TEST 
BED  MECHANISM  IN  THE  STOW  POSITION  PRIOR  TO  MAKING 
AUTOMATICALLY  CONTROLLED  RUNS  OR  AFTER  COMPLETION  OF  RUNS. 

JDI  11/12/88 


CLS 

C  =  StH330  :  P  =  C  +  3  :  SOLENOIDS  =  C  +  1 
OUT  C,0 

OUT  SOLENOIDS, 255 

PRINT  "  ENTER  1  TO  COMMENCE  STOW  ROUTINE.  PRESS" 
PRINT  "  KILL  SWITCH  WHEN  ARM  IS  FULLY  LOWERED." 
INPUT  A% 

IF  A%  <>  1  THEN  GOTO  100 
AV%  =  2 
HV%  =  32 

ORDER%  =  AVI  OR  HV% 

NORDERI  =  NOT (ORDER!) 

OUT  SOLENOIDS, NORDERI 
DO  WHILE  Al  =  1 

S  =  INP(&H331)  AND  16 
IF  S  =  0  THEN  GOTO  100 
LOOP 

100  OUT  SOLENOIDS, 255 

CLS 

END 
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